ASDPathfindingAssignment - A* Algorithm